// main.c
// George damit
// standard libs
#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>

// additional libs 
#include "avr/LCD_functions.h"
#include "avr/util.h"

extern volatile char KEY_VALID;

// Motor control circuit is connected to PortB  
//                              +---+---+---+---+---+
//            Port B            | 1 | x | X | X | V |  Pins marked with an X are not be used.  
//     Motor Contorl pins       +---+---+---+---+---+
//                              | 0 | x | x | x | G |  
//                              +---+---+---+---+---+
//  PB0 - Left motor PWM
//  PB1 - Right motor PWM

	

int main (void)
{ 
    Initialization();   //

	OriginalHeading = 0x7A;
    //
	while(1)
	{	
		printLCD("Full Speed ahead");
		TimerWait(500);		// delay while letting go!
		SetLeftMotorPWM(10);
		SetRightMotorPWM(10);
		TimerWait(1000);
        printLCD("Stop");
		SetLeftMotorPWM(0);
		SetRightMotorPWM(0);
		TimerWait(1500);
        	
	}
}	
	
 
